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@ optical position and orientation measurament techniques. 

@ A non-contact sensing system for monitoring the posi- 
tion and orientation of a rigid body in space having at least 
three distinct point light sources mounted thereon. At least 
two position sensor heads (5.7) are fixedly mounted within 
detection range of light from the light sources, each position 
sensor head having a position sensitive detector. The lights 
are illuminated one at a time and in sequential arrangement 
and a processor (15) computes the position In three-dimen- 
sional space of an illuminated light source with data provided 
simultaneously by both position sensitive detectors. The pro- 
cessor also computes the position of the object in all six 
degrees of freedom using the three-dimensional positional 
data of all three light sources. 
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OPTICAL POSITION AND ORIEISfTATION MEASUREMEKT TEC Ig^qg^^ g 



Hie invention relates to a non- contact 
sensing system for monitoring the position and 
5 orientation of a rigid body in space. More specific- 

ally, the invention relates to such a systM which can 
monitor the position and orientation of a pilot's 
helmet within the cockpit of a high performance 
tactical aircraft siirailator. 

10 

In order for aircraft simulators to provide 
a realistic siimilation of aircraft flight, it is 
necessary to display a simulated sxirroianding environ- 
ment to the simulator pilot. In currently available 
15 flight simulators, the displays are provided on the 

windscreens in the cockpit areas. Ihese systems 
require one CRT for each such w in dscreen. With such 
a system, images of equal quality must he generated 
in each CRT regardless of where the pilot is looking. 
20 Thig is costly both in terms of hardware and computer 

time. 

However, by projecting the image directly 
onto the visor of a pilot's helmet, a significant 
cost saving can be realized since the field of view 

25 is greatly reduced so that both the quality of the 

image (i.e. resolution) and the frame rate can be 
reduced, OSie field of view would be head slaved in 
order to provide an image which is instantaneously 
limited to the pilot's viewing area but which can 

30 be redirected to permit the pilot to "look* in any 

direction. It is also conten^lated to track eye 
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poalliijan or point: of regard and provide a blgiier 
XB3aXjxk±an linage slaved tx> tbe eye's foveal eurea. 
In sudi a system, -the pllo-t wotild f>ercelve blgn 
resolutilcHi ijnagery wberever be loolcs. Ho*rever, at 
any Instianli. tlie system is only required to produce 
lilgb resolution Images over a 15** cone. 

One of tKe dif f icilLties associated witla the 
use o£ lielnet iDounted visor displays is the maintenance 
of ioage stal»JJ.ty. In order for the computer generated 
image to appear stationary as the pilot iDoves his head, 
the position of the pilot *s helmet must be Itnown 
relative to the sinniTator's fixed axis. This position 
is defined hy three translation parameters (X, Y, Z) 
and three rotation parameters (Euler Angles). TUlLs 
Information is also necessary in order to align the 
ccoipixter generated Image with the frame of the wind- 
screen. Aus, a (helmet) position sensing system is 
needed. 

Currently avallahle non— contact position 
sensing systems conprlse a magnetic system as described 
In Raal>» F.H. , Blood, £.B. « Stelner, T.O. , and «7ones, 
H.R. , •Magnetic ^sltion and Orientation stacking 
System* , IKEE Transactions on Aerospace and Electronic 
Systems . Vol. AES-IS, Ho. 5, September 1979, pp. 
709-718, and a V— slit system as described in I*ewis, 
C. J.G. , "Helmet Mounted Display and Sight Develop- 
Bient*, Proceedings of the American Helicopter Society . 
May 1979, pp. 79.17.1-79.17.13. However, both of 
these systems fall to meet required specifications. 
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It is therefore an object of tlie Invention 
to provide a non-contact position sensing system which 
meets the required specifications. 
5 In accordance with the invention, the system 

monitors the position orientation of a Isody in space 
which has at least three distinct point light sources 
mounted thereon. The system includes at least two 
position sensor heads each of whici includes a 
10 position sensitive detector, 

The invention will be better understood by 
an examination of the following description, together 
with the accompanying drawings, in which: 
15 FIGURE 1 is a schematic diagram of the 

inventive system; 
FIGURE 2a is a schematic diagram of a 
position sensitive detector: 
FIGURE 2b is an electron flow diagram of 
20 the position sensitive detector; 

and 

FIGURE 3 illustrates an analog position 

processing circuit for processing 
data of the position sensitive 
25 detector. 

Referring to Figure 1, 1 is a rigid object 
in space whose position and orientation must be 
monitored. In the particular ^nbodiment illustrated, 
30 1 is a helmet which is worn by a pilot in the cockpit 

of a high performance tactical aircraft simulator. 
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A Boun^ijog plate 3 carz-ies a'b Xeast three 
point. Xxgt&t. sonxces, preferably I.£X>*s^ and the moiintxng 
plate xs mounted on the helmet. Ohvaously, the LED's 
coold he mounted directly on the helme't Instead of on 
a MonnMng plate. 

Fixedly mounted in the cockpit are position 
sensor heads 5 and 7. The sensor heads are xoounted 
within detection range of the light from the I.KDs , 
and afendlrected at the L£Ds. Camera lenses 6 and 
8 are disposed In front of the position sensor heads 
for reasons explained below. 

As the position sensor head Is sensitive to 
a %rlde apectmrn of light, bandpass Interference filters « 
n lustxated schgroa t i c^a 1 ly at 9 and XI, are placed In 
front of each lens to minimize the effect of ambient 
light. ^!£be filters are spectrally matched to the 
light of the I*ED8. 

Bach position sensor head Includes a position 
sensitive detector which will be discussed In aisso- 
elation with Figures 2 and 3 below. 

Sie output of each position sensor head Is 
fed to an analog— to-digital converter 13^ and the 
digital data Is then fed to a computer 15. One output 
of 15 Is fed to a controller 17 which provides a host 
ooopater %d.th the posltlcxi and orl station information 
of the helmet as cornqputed in the con^>uter. 

As Is known, and will be discussed below, 
at least three LEDs coupled with two position sensor 
headfl are needed to determine the position and 
orientation of the helmet in all six degrees of 
freedoB. In accordance with the invention « the 
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I<EDs are illuminated one at a time, and in sequentdLal 
arrangement « and tlie three dimensional position o£ 
each Tr'"^ is determined hy a triancrulation scheme 
using the data from the two position sensor heads. 

It is also necessary to maintain a constant 
light intensity of each I*ED regardless of the position 
or orientation of the helmet . 

y.Tm controller 19 maintains a constant light 
intensity of the LEDs and also illuminates the LEDs 
one at a time and in sequential arrangement. As can 
be seen, the controller 19 is controlled try the com- 
puter 15 which determines the recjuired LED current to 
maintain a constant light intensity as a function of 
the position of the helmet. The computer also selects 
the particular LED to be illuminated, and taXes into 
account the fact that it was this USD illuminated when 
computing the position and orientation of the helmet. 

Turning now to Figures 2A and 2B, as can he 
seen, the position sensitive detector is a planar 
photodiode 21 with veiry uniform resistive layers 
formed over both the top and bottom surfaces. T5ie 
camera lenses 6 and 8 are used to focus the infrared 
light from the LEDs onto the active area of this 
detector. 

This results in the generation of electron- 
hole pairs in the depletion layer directly iinder the 
light spot. The electrons migrate to the N- layer 
where they are channelled between two electrodes. 
Since the N-layer has a uniform resistivity, the 
current tXawLng to the pair of Y electrodes will 
depend on its distance from the point of incidence 
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of thG light. 

ISie nrmo basic pr±nei pies apply to the 
P-layer, i.e., boles w±ll mxgratie to the P- layer. 
The cnxxent signals are tben processed using « for 
example, the circuitry Illustrated In Figure 3« 

Turning nc3W to Figxure 3, tbe processing 
circuit ccjuipilses preamps 23 connected to eacb one 
of tbe X and Y electrode pairs. Adders 25A add the 
contents of the X electrodes and adders 25B add the 
contents of the y electrodes. Subtractors 27A sub- 
tract tbe contents of the X electrodes and sub- 
tractors 27b subtract the contents of the Y electrodes. 
!Ehe outputs of 25A and 27A are fed to bacicground 
cancellation circuits 29A and the outputs of 25B 
and 27B are fed to background cancel 1 a tlon circuits 
29fi, and tbe outputs of cancellation circuits 29 A and 
29B are fed to dividers 31A and 31B, respectively. 

With filtering, as per filters 9 and 11, the 
resolurtlou of the position sensor head can be as high 
as 0.02% of full scale. ISie filtering is necessary 
because of the high frequency jitter vhlch is normally 
present. With tbe dynamic performance of the inventive 
device, it can be used for vibration measurements at 
fregaencies of up to 50 XHz. 

It is necessary to use two sensors viewing 
the same I*ED patterns (at leEtst three I.£Ds) to uniquely 
detemlne the helmet position in all six degrees of 
freedom. Tbe image on the sensitive area of the 
detector of each LED is a two—dijnenslonal perspective 
projection of an Z»ED moving in three-dimensional space. 
Consequently, the three-dimensional position of LED 
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caxmo'k l>e recovered from ±t^ image coordinates. A-t 
best, only tlie direction of tlie vector between the 
and tlie sensor can be determined. If each LED 
is viewed from two locations, a triangulation scheme 
rap be used to confute the position of each LED in 
three dimensions. Hierefore, with a ministum of three 
LEDs and two sensors , the helmet position can be 
uniquely determined in all six degrees of freedom. 

The addition of more LHDs results in an 
overdeterroined system of equations which can increase 
the accuracy of the measurement through the appli- 
cation of least squares analysis as taught in Roach, 
J.W. and Aggarwal, J.K. , ^Determining the MovMient of 
Objects from a Sequence of Images'* , tptfp. T ransactions 
on Pattern Analysis and Machine Intf^n i pence ^ Vol. 
PAMI-2, No- 6, November 1980, pp. 554-562. 

Data processing taslcs for the optical helmet 
position sensing systems are accomplished, in one 
embodiment, by an INTEL iSBC 86/12 single board com- 
puter, ghis Board *s capabilities are summarized as 
follows : 



CPU 


8086 


CPU SPEED 


5MHz 


HAM (BASE BOARD) 


32 K 


EPRCX4 (BASE BOAKD) 


16 K 


SERIAL I/O 


1 


PARALLEL I/O LINES 


24 


TIMERS 


2 


INTERRUPTS 


8 
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In oraer to determine tlie lielxaet position and 
or±ent:al:i.an, a large nuxnber of floating point operations 
must be perf or»ed. Several trigometxic functions are 
also requixed. Bie floating point operations can be 
5 performed tlie 8087 Ktameric Processor. The 8087 

lias th/a aliility to perforin the tiigh speed floating 
point matheBatics required in cooplex control 
algori tfasns , 

Belmet position and orientation data are, as 
lO alsove-mentioned, transferred frcam the computer to a 

lK>st computer. In tlie preferred exnbodiment , tlie trans- 



puter. In tliis embodiment, the control 17 ccanprises 
a MOLTIBUS-SELBUS Controller (MBSEL). abe MBSZL board 
15 is an intalligent MA controller vhich coamnmicates 

with tlie SEIiBDS via a high speed data interface board 
(BSD). Because of the 86/12 board's dual port RAM, 

MBSEl* access the position and orientation 

data directly via the MULTIBUS. Data transfers are 
20 transparent to both the SEL and B086 processors. 

Again, in the particular embodiment, a 
custom-laailt analog board 13 is tised to read the out- 
pat signals from the position sensor heads and to 
convert then into digital signals. In order to 
25 ninimize the conversion time, two iiwaependent 14-bit 

analog— tjOTdigital converters were included on this 
board. 

Methods for the mathematical analysis of 
data are taught in, for example, Lenox. J.B., 
30 Six Degree o^ Freedom Human Eveball Move ment Analysis 

Involving Steriometric Technicmes . Ph.D. OJhesis, 
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fer from the xmEL 86/12 is to a SEL 32/55 host com- j 
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Stanford University, Stanford, California, 1976, 
Schut, G,H., •On Exact Idjiear Equations for tlie 
Computation of the Rotational Elements of Alisolute 
Orientation", Photogrammetria , Vol. 17, No. 1, 1960, 
pp. 34-37, Schut, G.H. , ^Formation of Strips from 
Independent Models" , AP-PR 36, MRC-9695 , Division of 
Physics, National Research Council of Canada, Ot-tawa, 
July 1967, and Thompson, £.H. , "An Exact Linear 
Solution of the Problem of Absolute Orientation" , 
Photoarammetria , Vol. 15, No. 4, 1959, pp. 163-179. 

In comparison with other non-contact 
position sensing systems, the inventive system offers 
high resolution and speed at a relatively low cost, 
^ese features suggest other possible applications of 
the inventive system in the areas of robot vision, 
industrial control, kinesiology and laboratory 
instrumentation. Accordingly, the inventive system 
has uses outside of the environment as described 
above in the preferred embodiment. 

Although a particular embodiment has been 
described, this was for the purpose of illustrating, 
but not limiting, the invention. Various modifi- 
cations, which will come readily to the mind of one 
slcilled in the art, are within the scope of the 
invention as defined in the appended claims. 
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1. A noo-oont^d: sensing system for moni^rlDg 

tbe positi.an and orien^^on o£ a rigid lx>dy iis space 
wberein at least tjhree distinct point light sources 
are laounted en said tody for muv u u ent therewith: 
said system coBqarising: 

at least two position sensor heads fixedly 
mounted within detection range of light f rcan said 
light sources, said position sensor heads heing 
directed at said light sources 7 

characterized in that each position sensor 
head j n^"* a position sensitive detector: 

for -1 nT-im-i-oa-hS rfcfj said light sources 
one at a tiiar' and in a sequential arrangement; 

processor means; 

said position sensitive detector outputs 
helng connected to the input of said processor means: 

said processor means helng adapted to cck&- 
pute position in three-diiaenslonal space of an 

lllumlx&ated light source with data concerning said 
lUuDilnated light source provided simultaneously by 
hoth posltlcm sensitive detectors; 

said processor means also being adapted to 
ccn^xxte the position of said object in all six degrees 
of freedom using the three-dimensional positional 
data of all three light sources. 
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2. A system as defined in claim 1 wherein said 

position sensitive detectors provide analog signals 
at their outputs: 

2malog- to-digital conversion means between 
the outputs of said position sensitive detectors and 
the input of said processing means whereby to convert 
said analog signals into digital signals for use in 
said processor means. 

3. A system as defined in claim 2 and including 
means for varying power to said light sources whereby 
to maintain a constant light intensity from each light 
source at said position sensitive detectors regardless 
of the position and orientation of said rigid body. 

4. A system as defined in claim 3 and further 
including lens means on each position sensor head 
whereby to focus light from said light sources onto 
a respective position sensitive detector. 

5. A system as defined in claim 4 and including 
filter means on each lens, the filter means being 
spectrally matched to the light sources. 

6. A systCTEi as defined in claim 5 wherein said 
rigid body ccnnpri ses a pilot's helmet within the cock- 
pit of an aircraft simulator: 

said position sensor heads being mounted 
in the interior of said simulator, 

7^ A system as defined in claim 6 wherein said 

light sources comprise LEDs , said means for varying the 
light intensity comprising means for varying the ctxrrent 
to said I«KDs. 
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e« A ncM>-cont:ac^ Mtbod for moxii-borlng the 

pos±^can and orientation of a rigid body in space 
baving at least three distinct point light sources 
w>unt:ed thereon for aovonent therewith: 

at least two position sensor heads fixedly 
Bounded within detection range of light from said 
light souroes, each position sensor head in r1 Tidin g 
a positicxi sensitive detector, said position sensor 
heads heing directed at said light sources: 

and a processor means: 

said method ccooprising: 

■iT TtTiPT n a j-? rvj said light sources one at a 
^ and in sequential arrangement: 

computing, hy said processor means, the 
position in three-dimensional space of an illuminated 
lialit source with data concerning said illuminated 
light source provided simultaneously hy hoth position 
srasitive detectors to said processor means: 

coB^auting the position of said ohject in 
all six degrees of freedom using the three-dimensional 
positicanal data of all three light sources « 
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